home *** CD-ROM | disk | FTP | other *** search
- #include <stdio.h>
- #include "global.h"
- #include "mbuf.h"
- #include "ax25.h"
- #include "timer.h"
- #include "lapb.h"
- #include "trace.h"
-
- char *decode_type();
- int16 ftype();
- static void netrom_dump();
-
- /* Dump an AX.25 packet header */
- ax25_dump(bpp,check)
- struct mbuf **bpp;
- int check; /* Not used */
- {
- char tmp[20];
- char control,pid,seg;
- int16 type;
- struct ax25 hdr;
- struct ax25_addr *hp;
-
- printf("AX25: ");
- /* Extract the address header */
- if(ntohax25(&hdr,bpp) < 0){
- /* Something wrong with the header */
- printf(" bad header!\n");
- return;
- }
- pax25(tmp,&hdr.source);
- printf("%s",tmp);
- pax25(tmp,&hdr.dest);
- printf("->%s",tmp);
- if(hdr.ndigis > 0){
- printf(" v");
- for(hp = &hdr.digis[0]; hp < &hdr.digis[hdr.ndigis]; hp++){
- /* Print digi string */
- pax25(tmp,hp);
- printf(" %s%s",tmp,(hp->ssid & REPEATED) ? "*":"");
- }
- }
- if(pullup(bpp,&control,1) != 1)
- return;
-
- putchar(' ');
- type = ftype(control);
- printf("%s",decode_type(type));
- /* Dump poll/final bit */
- if(control & PF){
- switch(hdr.cmdrsp){
- case COMMAND:
- printf("(P)");
- break;
- case RESPONSE:
- printf("(F)");
- break;
- default:
- printf("(P/F)");
- break;
- }
- }
- /* Dump sequence numbers */
- if((type & 0x3) != U) /* I or S frame? */
- printf(" NR=%d",(control>>5)&7);
- if(type == I || type == UI){
- if(type == I)
- printf(" NS=%d",(control>>1)&7);
- /* Decode I field */
- if(pullup(bpp,&pid,1) == 1){ /* Get pid */
- if(uchar(pid) == PID_SEGMENT){
- pullup(bpp,&seg,1);
- printf("%s remain %u",seg & SEG_FIRST ?
- "First seg;" : "",seg & SEG_REM);
- if(seg & SEG_FIRST)
- pullup(bpp,&pid,1);
- }
- printf(" pid=");
- switch(uchar(pid)){
- case PID_SEGMENT:
- break; /* Already displayed */
- case PID_ARP:
- printf("ARP\n");
- arp_dump(bpp);
- break;
- case PID_NETROM:
- printf("NET/ROM\n");
- netrom_dump(bpp);
- break;
- case PID_IP:
- printf("IP\n");
- ip_dump(bpp,pid);
- break;
- case PID_NO_L3:
- printf("Text\n");
- break;
- default:
- printf("0x%x\n",pid);
- }
- }
- } else if(type == FRMR && pullup(bpp,tmp,3) == 3){
- printf(": %s",decode_type(ftype(tmp[0])));
- printf(" Vr = %d Vs = %d",(tmp[1] >> 5) & MMASK,
- (tmp[1] >> 1) & MMASK);
- if(tmp[2] & W)
- printf(" Invalid control field");
- if(tmp[2] & X)
- printf(" Illegal I-field");
- if(tmp[2] & Y)
- printf(" Too-long I-field");
- if(tmp[2] & Z)
- printf(" Invalid seq number");
- printf("\n");
- } else
- printf("\n");
-
- }
- /* Display NET/ROM network and transport headers */
- static void
- netrom_dump(bpp)
- struct mbuf **bpp;
- {
- struct ax25_addr src,dest;
- char x;
- char tmp[16];
- char thdr[5];
- register i;
-
- if(bpp == NULLBUFP || *bpp == NULLBUF)
- return;
- /* See if it is a routing broadcast */
- if(uchar(*(*bpp)->data) == 0xff) {
- pullup(bpp,tmp,1); /* Signature */
- pullup(bpp,tmp,ALEN);
- tmp[ALEN] = '\0';
- printf("NET/ROM Routing: %s\n",tmp);
- for(i = 0;i < 11;i++) {
- if (pullup(bpp,tmp,AXALEN) < AXALEN)
- break;
- memcpy(src.call,tmp,ALEN);
- src.ssid = tmp[ALEN];
- pax25(tmp,&src);
- printf(" %12s",tmp);
- pullup(bpp,tmp,ALEN);
- tmp[ALEN] = '\0';
- printf("%8s",tmp);
- pullup(bpp,tmp,AXALEN);
- memcpy(src.call,tmp, ALEN);
- src.ssid = tmp[ALEN];
- pax25(tmp,&src);
- printf(" %12s", tmp);
- pullup(bpp,tmp,1);
- printf(" %3u\n", uchar(tmp[0]));
- }
- return;
- }
- /* Decode network layer */
- pullup(bpp,tmp,AXALEN);
- memcpy(src.call,tmp,ALEN);
- src.ssid = tmp[ALEN];
- pax25(tmp,&src);
- printf("NET/ROM: %s",tmp);
-
- pullup(bpp,tmp,AXALEN);
- memcpy(dest.call,tmp,ALEN);
- dest.ssid = tmp[ALEN];
- pax25(tmp,&dest);
- printf("->%s",tmp);
-
- pullup(bpp,&x,1);
- printf(" ttl %d\n",uchar(x));
-
- /* Read first five bytes of "transport" header */
- pullup(bpp,thdr,5);
- switch(thdr[4] & 0xf){
- case 0: /* network PID extension */
- if (uchar(thdr[0]) == PID_IP && uchar(thdr[1]) == PID_IP)
- ip_dump(bpp,1) ;
- else
- printf(" protocol family %x, proto %x",
- uchar(thdr[0]), uchar(thdr[1])) ;
- break ;
- case 1: /* Connect request */
- printf(" conn rqst: ckt %d/%d",uchar(thdr[0]),uchar(thdr[1]));
- pullup(bpp,&x,1);
- printf(" wnd %d",x);
- pullup(bpp,(char *)&src,sizeof(struct ax25_addr));
- pax25(tmp,&src);
- printf(" %s",tmp);
- pullup(bpp,(char *)&dest,sizeof(struct ax25_addr));
- pax25(tmp,&dest);
- printf("->%s",tmp);
- break;
- case 2: /* Connect acknowledgement */
- printf(" conn ack: ur ckt %d/%d my ckt %d/%d",
- uchar(thdr[0]), uchar(thdr[1]), uchar(thdr[2]),
- uchar(thdr[3]));
- pullup(bpp,&x,1);
- printf(" wnd %d",x);
- break;
- case 3: /* Disconnect request */
- printf(" disc: ckt %d/%d",uchar(thdr[0]),uchar(thdr[1]));
- break;
- case 4: /* Disconnect acknowledgement */
- printf(" disc ack: ckt %d/%d",uchar(thdr[0]),uchar(thdr[1]));
- break;
- case 5: /* Information (data) */
- printf(" info: ckt %d/%d",uchar(thdr[0]),uchar(thdr[1]));
- printf(" txseq %d rxseq %d",uchar(thdr[2]), uchar(thdr[3]));
- break;
- case 6: /* Information acknowledgement */
- printf(" info ack: ckt %d/%d",uchar(thdr[0]),uchar(thdr[1]));
- printf(" txseq %d rxseq %d",uchar(thdr[2]), uchar(thdr[3]));
- break;
- default:
- printf(" unknown transport type %d", thdr[4] & 0x0f) ;
- break;
- }
- if(thdr[4] & 0x80)
- printf(" CHOKE");
- if(thdr[4] & 0x40)
- printf(" NAK");
- printf("\n");
- }
- char *
- decode_type(type)
- int16 type;
- {
- switch(uchar(type)){
- case I:
- return "I";
- case SABM:
- return "SABM";
- case DISC:
- return "DISC";
- case DM:
- return "DM";
- case UA:
- return "UA";
- case RR:
- return "RR";
- case RNR:
- return "RNR";
- case REJ:
- return "REJ";
- case FRMR:
- return "FRMR";
- case UI:
- return "UI";
- default:
- return "[invalid]";
- }
- }
-
-